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Here are some easy to use 16- and 32-bit math routines 
that take the pain out of calculations such as PID 
loops, A/D calibration, linearization calculations and 
anything else that requires 32-bit accuracy. 

The package is written to interface with PL/M-51. Pa- 
rameters are passed as 16-bit words to the routines, 
which perform operations on a 32-bit "accumulator" 
resident in memory. The following functions are per- 
formed: 

Load_16 (word_param) 

Loads a 16-bit -RD into the low half of the 32-bit "ac- 
cumulator", zeros upper 16 bits of accumulator. 

Load_32 (word_hi,word_lo) 

Loads word_hi into upper 1 6 bits of accumulator, word 
lo_into Lower 1 6 bits. 

Low_16 

Returns the lower 16 bits of the accumulator, bits 
through 15. 

Mid_16 

Returns the middle 16 bits of the accumulator, bits 8 
through 23. 

High_16 

Returns the upper 16 bits of the accumulator, bits 16 
through 31. 

Mul_16 (word_param) 

Multiplies the 32-bit accumulator by the 16-bit word 
supplied, result left in accumulator. 

Div_16 (word_param) 

Divides the 32-bit accumulator by the 16-bit word sup- 
plied, result left in accumulator. 

Add_16 (word_param) 

Adds the 16-bit word supplied to the 32-bit accumula- 
tor. 



Sub_16 (word_param) 

Similar to Add_16 but for subtraction. 

Add_32 (word_hi,word_lo) 

Forms a 32-bit value for word_hi and word_lo and 
adds it to the accumulator. 

Sub_32 (word_hi,word_lo) 

Similar to Add_32 but for subtraction. 



APPLICATION 

Typical applications have 16-bit "input" values and 
produce 16-bit "output" values, but require 32-bit val- 
ues for intermediate results. An example would be 
reading a 12-bit A/D, performing some gain and offset 
calculation on the raw A/D data to produce a calibrat- 
ed 16 bit result. Doing this is a simple task with this 
math package. 

CALL Load_16(AD_ value) ; 

CALL Add_16 (of f set_value) ; 

CALL Mul_16 (gain-factor) . 

/* gain is in units of 1/256 */ 

result = Mid_16 ; 

In this example the accumulator was loaded with the 
raw A/D value and then the offset was applied. The 
gain_factor was "pre-multiplied" by 256 (8 bits), giving 
it a granularity of 1/256. The result was extracted from 
the "middle" 16 bits of the accumulator (bits 8 to 23) to 
account for the scaling factor of 256 introduced in the 
multiply step. 

The package requires about 384 bytes of ROM and 30 
bytes of RAM. Individual routines can be deleted to 
conserve RAM if they are not used- 
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CODE SOURCE LISTINGS 



CODE SOJBCE LISTINGS 



NAME Math_32_Module 




PUBLIC Load 


16, 


?Load 16?byte 


PUBLIC Load 


32, 


?Load 32?byte 


PUBLIC Mul 


16, 


?Mul 


16?byte 


PUBLIC Div" 


16, 


?Div~ 


16?byte 


PUBLIC Add 


16, 


?Add" 


16?byte 


PUBLIC Sab 


16, 


?Sub" 


"l6?byte 


PUBLIC Add 


32, 


?Add~ 


32?byte 


PUBLIC Sub 


32, 


?Sub" 


"32?byte 


PUBLIC Lcw_ 


16, 


Mid_16, High_16 


Math 32 Data 


SEGMENT DATA 


Math_32_Code 


SEGMENT CODE 


RSBG Math 32 Data 




?Load 16?byte: 


DS 


2 




TLoad 32?byte: 


DS 


4 




?MuW6?byte: 


DS 


2 




?Div~16?byte: 


DS 


2 




?Add 16?byte: 


DS 


2 




?Sub 16?byte: 


DS 


2 




?Add 32?byte: 


DS 


4 




?Sub 32?byte: 


DS 


4 




OP 0: 


DS 


1 




OP 1: 


DS 


1 




OP 2: 


DS 


1 




OP 3: 


DS 


1 




TOP 0: 


DS 


1 




TOP 1: 


DS 


1 




IMP 2: 


DS 


1 




TOP 3: 


DS 


1 




RSEG Math_32_Code 
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Load 16 : 






;Load 


the lower 16 bits of the OP registers with the value supplied 




MOV 


OP 3,#0 




!OV 


OP - 2,»0 




MOV 


OP_l,?Load_16?byte 




MOV 


OP_0,?Load_i6?byte + 1 




RETT 






Load 32: 






;Lcad 


all the OP registers with the value supplied 




MOV 


OP 3,?Load 32?byte 




MOV 


OP 2,?Load~32?byte + 1 




MOV 


OP l,?Load 32?byte + 2 




MOV 


OP 0,?Load 32?byte + 3 




RET 






Low 16: 






;Retum the lower 16 bits of the OP registers 




MOV 


R6,OP 1 




MOV 


R7 ,OP_0 




RET 






Mid 16: 






; Return the middle 16 bits of the OP registers 




MOV 


R6,OP 2 




MOV 


R7.0PJ. 




RET 






High 16: 






;Return the high 16 bits of the OP registers 




MOV 


R6,OP 3 




MOV 


R7,OP_2 




RET 






Add 16: 






;Add 


the 16 bits supplied by the caller to the OP registers 




CLR 


C 




MOV 


A,OP_0 




ADDC 


A,?Add 16?byte +1 ;low byte first 




MOV 


OP 0,A 




MOV 


A,OP_l 




ADOC 


A,?Add 16?byte ;high byte + carry 




MOV 


OP 1,A 




MOV 


A,OP_2 




ADOC 


A i*0 ; propagate carry only 




MOV 


OP 2, A 




MOV 


A,OP_3 




AD DC 


A '*0 ; propagate carry only 




MOV 


OP_3,A 




RET 
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Add 32: 








;Add 


the 32 bits supplied by the caller to tne OP registers 




CLR 


C 






["DV 


A, OP 






ADDC 


A,?Add 32?byt= + 3 


; lowest byte first: 




MOV 


OP 0,A 






(■DV 


A, OP 1 






ADOC 


A,?Add 32?byte + 2 


; mid-lowest byte + carry 




mov 


OP 1,A 






MOV 


A, OP 2 






ADDC 


A,?Add 32?byte + 1 


; mid-highest byte + carry 




MOV 


OP 2, A 






M3V 


A,OP 3 






ADDC 


A,?Add 32?byte 


; highest byte + carry 




MOV 


OP 3, A 






RET 








Sub 16: 








;Subtract the 16 bits supplied by the caller from the OP registers 




CLR 


C 






MOV 


A, OP 






SUBB 


A,?Sub 16?byte + 1 


;low byte first 




MOV 


OP 0,A 






MOV 


A, OP 1 






SUBB 


A,?Sub 16?byte 


;high byte + carry 




MOV 


OP 1,A - 






MOV 


A,OP 2 






SUBB 


A,#0 


; propagate carry only 




MOV 


OP 2, A 






MOV 


A, OP 3 






SUBB 


A, 10 


; propagate carry only 




MOV 


OP 3, A 






RET 








Sub 32: 








,-Subtract the 32 bits supplied by the caller from the OP registers 




CLR 


C 






MOV 


A, OP 






SUBB 


A,?Sub 32?byte + 3 


; lowest byte first 




MOV 


OP 0,A 




MOV 


A, OP 1 






SUBB 


A,?Sub 32?byte + 2 


; mid- lowest byte + carry 




MOV 


OP 1,A 




MOV 


A, OP 2 






SUBB 


A,?Sub 32?byte + 1 


; mid-highest byte + carry 




MOV 


OP 2, A 




MOV 


A, OP 3 






SUBB 


A,?Sub 32?byce 


; highest byte + carry 




MOV 


OP 3, A 




RET 
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Mul 16: 








(Multiply the 32 bit OP with the 16 value supplied 




MDV 


IMP 3,#0 


;clear out upper 16 bits 




mdv 


TMP~2,»0 






;Generate the lowest 


oyte of the result 




MOV 


B,OP 






MDV 


A,?Mul 16?byte+l 




MUL 


AB 






MOV 


IMP 0,A 


; low-order result 




MOV 


IMP 1,B 


;high order result 




;Now generate che next higher order byte 




MDV 


B f OP 1 






MOV 


A,?Mul 16?byte+l 




MUX 


AB 






ADD 


A, IMP 1 


; low-order result 




MDV 


IMP 1,A 


; save 




MDV 


A,B 


; get high-order result 




ADDC 


A, IMP 2 


; include carry from previous operation 




MDV 


TOP_2,A 


; save 




JNC 


Mul loopl 






INC 


IMP_3 


; propagate carry into TMP 3 




Mul loopl: 








MOV 


B,OP 






MOV 


A,?Mul 16?byte 




MUL 


AB 






ADD 


A, IMP 1 


; low-order result 




MDV 


TMP 1,A 


; save 




MOV 


A,B 


; get high-order result 




ADDC 


A, TMP 2 


; include carry from previous operation 




MOV 


TMP_2,A 


; save 




JNC 


Mul loop2 






IMC 


TOP_3 


i propagate carry into TMP_3 




Mul loop2: 








; Now start working on the 3rd byte 




MOV 


B,OP 2 






MOV 


A,?Mul 16?byte+l 




MUL 


AB 






ADD 


A.TMP 2 


; low-order result 




MOV 


TMP 2, A 


; save 




MOV 


A,B 


; get high-order result 




ADDC 


A, TMP 3 


; include carry from previous operation 




MDV 


TOP 3, A 


; save 




; Now 


the other half 






MOV 


B,OP 1 






MOV 


A,?Mul 16?byte 






MUL 


AB 






ADD 


A, TMP 2 


; low-order result 




MOV 


TOP 2, A 


; save 




MOV 


A,B~ 


; get high-order result 




ADDC 


A, IMP 3 


; include carry from previous operation 




MOV 


TMP_3,A 


; save 




; Now 


finish off the 


highest order byte 




MOV 


B,OP 3 




MOV 


A,?Mul_16?byte+l 
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MUL AB 

ADD A,TMP_3 ; low-order result 

MOV TMP_3,A ; save 

; Forget about the high-order result, this is only 32 bit math! 

MDV B,OP_2 

MOV A,?Mul_16?byte 

MUL AB 

ADO A,TMP 3 ; low-order result 

MOV TMP_37a ; save 

; Now we are all done, move the TOP values back into OP 

MOV OP_0,TOP_0 

MOV 0P_L,TMP_1 

MOV OP_2,1MP_2 

MOV OP_3,TMP_3 

RET 
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Div_16: 

;This divides the 32 bit OP register by the value supplied 
MOV R7,#0 

MOV R6,&0 ; zero out partial remainder 

MOV TMP_0 , #0 
MOV TMP_1,#0 
MOV TMP_2,#0 
MOV IMP_J,#0 

MOV Rl,?Div_16?byte ;load divisor 
MOV R0,?Div_16?byte+l 
MOV R5,*32 ;loop count 

;This begins the loop 
Div_loop: 

CALL Shift_D ; shift the dividend and return MSB in C 

MOV A,R6 ; shift carry into LSB of partial remainder 

RLC A 

MOV R6,A 

MOV A,R7 

RLC A 

MOV R7 ,A 

;now test to see if R7:R6 >= R1:R0 

JC Can_sub ;Caxry out of R7 shift means R7:R6 > R1:R0 

CLR C 

MOV A,R7 ;subtract Rl from R7 to see if Rl < R7 

SUBB A,R1 ; A = R7 - Rl, carry set if R7 < Rl 

JC Cant_sub 

;at this point R7>R1 or R7=R1 

JNZ Can_sub ;jump if R7>R1 

;i£ R7 = Rl, test for R6>=R0 

CLR C 

MOV A,R6 

SUBB A,R0 ; A = R6 - RO , carry set if R6 < R0 

JC Cant_sub 
Can_sub: 

;subtract the divisor from the partial remainder 
CLR C 
MOV A,R6 

SUBB A,R0 ; A = R6 - R0 

MOV R6 ,A 
MOV A,R7 

SUBB A,R1 ; A = R7 - Rl - Borrow 

MDV R7,A 

SETB C ; shift a 1 into the quotient 

JMP Ouot 
Cant_sub : 

; shift a into the quotient 

CLR C 
Ouot: 

; shift the carry br_ into the quotient 

CALL Shift_Q 

; Test for competicn 

DJNZ R5 , Div_loop 

; Now we are all done, move the TMP values back into OP 
MOV OP_0,TMP_0 
MOV OP 1,TMP 1 
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MOV OP_2,TMP_2 

MDV OP_3,TMP_3 
RET 

Shift_D: 

; shift che dividend one bit to the left and return the MSB in C 

CLR C 

MOV A, OP 

RLC A ~~ 

MOV OP 0,A 

MOV A,OP_l 

RLC A 

MDV OP 1,A 

MOV A,OP_2 

RLC A 

MOV OP_2,A 

MDV A,OP_3 

RLC A 

MOV OP 3, A 

RET 

ShiftJJ: 

; shift the quotent one bit to the left and shift the C into LSB 

MOV A,TMP_0 

RLC A 

MDV TMP_0,A 

MDV A,TMP_1 

RLC A 

MOV TMP_1,A 

MOV A,TMP_2 

RLC A 

MOV TMP_2,A 

MOV A,TMP_3 

RLC A 

MDV 1MP_3,A 

RET 

END 
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